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ROBOT MOVEMENT CONTROL SYSTEM 



BACKGROUND OF THE INVENTION 

1 . Field of the Invention 

The present invention relates to a legged walking robot 
having at least a plurality of movable legs, and in 
particular relates to a movement control system for a legged 
walking robot capable of simultaneously executing a 
plurality of tasks such as a displacement, balance keeping, 
and an arm operation. 

In more detail, the present invention relates to a 
movement control system for a legged walking robot capable 
of determining the allocation of the driving amount of each 
joint in real time so as to simultaneously satisfy various 
movement constraint conditions imposed by each task, and in 
particular relates to a movement control system for a legged 
walking robot capable of operating by suitably allocating 
drive amounts of degrees of freedom of an entire body so as 
to simultaneously satisfy geometrical/dynamical and ever- 
changing various movement constraint conditions. 

2. Description of the Related Art 

A robot is a mechanical device which emulates the 
movement of a human being by making use of an electrical or 
magnetic action. The term robot is said to be derived from 
the Slavic word ROBOTA (slavish machine) . 
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In recent years, progress has been made in the research 
and development of legged mobile robots which emulate the 
movements and mechanisms of the body of an animal, such as a 
human being or a monkey, which walks on the two feet while 
in an erect posture, so that there is a higher expectation 
of putting them into practical use. Legged mobile robots 
which emulate the mechanism and movements of the bodies of 
human beings are especially called humanoid robots. 

The legged mobile robot is excellent in that it can 
achieve flexible walking operation, such as hurdling 
obstacles regardless of a non-finished ground and moving up 
and down a step or a ladder although the legged mobile robot 
is unstable and difficult to be controlled in posture and 
walking in comparison with a crawler-mounted robot and a 
robot on four-feet or six-feet. 

In comparison with industrial robots such as 
manipulators and carrier robots, legged mobile robots are 
characterized in that they are defined by multiple link 
systems including redundancies. Using such characterization, 
a plurality of tasks such as a displacement, balance keeping, 
and an arm operation can be simultaneously executed. 

On the other hand, a method is not axiomatic for 
determining the allocation of the driving amount of each 
joint in real time so as to simultaneously satisfy various 
movement constraint conditions imposed by a plurality of 
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tasks. In particular, since such movement constraint 
conditions ever change corresponding to operation 
environments/executing tasks of a legged mobile robot, it is 
required to have an algorithm capable of corresponding to 
changes in the movement constraint conditions in response to 
execution. 

For example, a biped with two arms robot is assumed to 
have situations imposed by the following movement constraint 
conditions : 

1) legs and hands are constrained on a floor when the robot 
gets up on the hands from a lying-on-f ace posture; 

2) the hands are constrained on a wall when the robot gets 
up by touching the hands on the wall; 

3) hands are constrained on a uniform linear moving track 
when the robot conveys an object without swinging; and 

4) both hands are constrained on a both-hands track when two 
robots operate hand in hand. 

Also, in order to maintain a dynamic balance, the 
following dynamic movement-constraint conditions are 
simultaneously imposed: 

1) the constraint to a translational momentum (gravity 
center track) of a robot; and 

2) the constraint to an angular momentum of the robot. 

Furthermore, in view of characteristics of actuators 
defining degrees of joints, situations are supposed where 



- 4 - 



the following inequality constraints are imposed: 

1) the constraint to a movable range of an actuator of a 
joint; and 

2) the constraint to a drive rate of the actuator of the 
joint . 

Therefore, the legged mobile robot represented by the 
humanoid robot must operate by suitably allocating drive 
amounts of degrees of freedom of the entire body so as to 
simultaneously satisfy ever changing various movement 
constraint conditions . 

As a study relating to a method for allocating drive 
amounts of joints of the entire body of a legged robot, 
there is a proposal of a method allocating drive amounts of 
degrees of freedom of the entire body for maintaining the 
standing balance on one foot while when an angular planned 
value of the entire body joints of a legged mobile robot is 
given, the planned value is reflected to the utmost (see 
"the dynamic balance compensation in real time using the 
entire body in the standing operation on one foot of a 
humanoid robot" by Tamiya et al., Journal of the Robotics 
Society of Japan, Vol. 17, No. 2, pp. 268-274, 1966) . 

However, since object problems of this method are 
limited to the standing state on one-foot; the entire body 
joints are used only for maintaining the balance; and there 
is no mention on a method for imposing an arbitrary 
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geometrical constraint, the method does not satisfy the 
above-mentioned requirement of simultaneously satisfying the 
various movement constraint conditions. 

Many of proposals made to prevent a legged mobile robot 
from falling down while it is walking use a ZMP (zero moment 
point) as a norm for determining the walking stability. The 
norm for determining the stability by the ZMP is based on 
the D'Alembert principle that in a walking system, 
gravitational forces, inertial forces, and moments thereof 
applied on a road surface balance reaction forces and 
reaction moments from the road surface. As a consequence of 
the dynamic postulation, there exists a point where the 
pitch axis moment and the roll axis moment become zero on or 
within a side of a support polygon defined by the surface of 
a path and points where soles contact the floor. In other 
words, a ZMP exists (see "legged locomotion robots" by 
Miomir Vukobratovic, and "walking robots and artificial 
legs" by Kato et al., published from Nikkan Kogyo Shinbun, 
for example) . The generation of a pattern for walking on 
two feet based on the ZMP as a norm has the advantage of 
allowing previous setting of the points where the soles 
contact the floor, making it easier to take into 
consideration kinematic constraint conditions of the toes in 
accordance with shapes of the path. Also, using the ZMP as 
a norm for determining the stability means that a target 
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value of the movement control is not a force but a track, so 
that the technical feasibility is increased. 

An example is reported in that based on the ZMP norm 
for determining the stability, a pattern for walking on two 
feet is generated by compensating the moment about the ZMP 
in operative coordination with a plurality of regions (see 
"the development of a biped walking humanoid robot-the biped 
walking control with the entire body coordination" by 
Yamaguchi et al., from the manuscript copies prepared for 
the third robotics symposia, pp. 189-196, 1998, for example) . 

However, also in this case, since object problems of 
this method are limited to walking; and there is no mention 
on a framework for imposing/relieving an arbitrary 
geometrical constraint, it is inferred that the method do 
not satisfy the above-mentioned requirement of 
simultaneously satisfying the various movement constraint 
conditions . 

The inventors point out the following reasons why 
conventional body-control algorithms cannot operate by 
suitably allocating drive amounts of degrees of freedom of 
an entire body so as to simultaneously satisfy ever-changing 
various movement constraint conditions: 

First, it is mentioned that the conventional body- 
control algorithms can add only small-numbered limited 
movement constraints on a specific problem. 



The movement constraints can be generated in not only 
the walking or standing but also in every movement states. 
At not only end points but also at positions/postures of 
every regions of the body, various constraints may be 
simultaneously generated, such as geometrical constraints, 
constraints over momentums of an entire system, and 
inequality constraints relating to the movable range/drive 
rate of actuators. In order to exhibit the functions of a 
legged robot with multiple redundancies to the utmost, it i 
considered that an algorithm capable of freely imposing 
these various constraints without being limited by specific 
movement states is necessary. 

Secondly, there may be few algorithms capable of 
corresponding to changes in dynamic movement-constraint 
conditions . 

The above-mentioned movement-constraint conditions are 
ever variable corresponding to tasks required and movement 
states of a robot. For example, when a legged mobile robot 
avoids an obstacle above the head, a geometrical constraint 
is imposed on a head positional track while the head is 
approaching the obstacle; then, the geometrical constraint 
is relieved after the head avoids the obstacle. 
Alternatively, when the load increase is detected at a 
specific joint, for protecting this joint, there may be a 
situation that a geometrical constraint is imposed so that 
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gait must be changed so as to maintain the balance using 
another region. If the robot cannot instantly reflect the 
movement constraint conditions changing in time to the 
movement in such a manner, the degree-of -freedom resources 
of the legged robot cannot be efficiently utilized, so that 
a legged robot capable of flexibly corresponding to tasks 
required cannot be achieved. 

Thirdly, there is no mention other than a fixed and 
unique strategy regarding to the drive method of 
redundancies . 

The drive method of the redundancies of the legged 
mobile robot is dynamically changeable by body conditions 
and kinds of tasks. There may be situation assumptions that 
redundancies are wanted and consumed for achieving the 
movement close to the general movement given in advance to 
the utmost while the appearance is weighted; and for 
reducing the load on an actuator, the joint drive amount is 
wanted and used to the utmost. In order that a legged robot 
efficiently drives the redundancy in accordance with 
situations, it is desirably considered to have a plurality 
of drive strategies of the redundancies so as to be 
dynamically changeable . 

SUMMARY OF THE INVENTION 

It is an object of the present invention to provide an 
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excellent movement control system for legged walking robots 
capable of simultaneously executing a plurality of tasks 
such as a displacement, balance keeping, and an arm 
operation. 

It is a further object of the present invention to 
provide an excellent movement control system for legged 
walking robots capable of determining the allocation of 
drive amounts of joints in real time so as to simultaneously 
satisfy various movement constraint conditions imposed by 
each task. 

It is a further object of the present invention to 
provide an excellent movement control system for legged 
walking robots capable of operating by suitably allocating 
drive amounts of degrees of freedom of an entire body so as 
to simultaneously satisfy geometrical/dynamical and ever- 
changing various movement constraint conditions. 

The present invention has been made in view of the 
problems described above, and in accordance with a first 
aspect of the present invention, in a movement control 
system for a robot having a base and a plurality of movable 
regions connected to the base, the system includes 
fundamental constraint-condition setters for setting 
movement constraint-conditions, which are imposed in 
accordance with a task and a movement state applied to the 
robot, for each kind of constraint; a constraint-condition 
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setting unit for imposing the movement constraint conditions 
of the entire robot necessary for a state variation of the 
robot by selectively using the appropriate fundamental 
constraint-condition setter in accordance with a movement- 
constraint requirement produced during execution of a task 
and a movement of the robot; and a drive-amount determining 
unit for determining a drive amount of each of the movable 
regions so as to satisfy the entire movement-constraint 
conditions set by the constraint-condition setting unit. 

Wherein the robot is a biped legged walking robot with 
two arms, for example. The plurality of movable regions 
include at least the upper limb, the lower limb, and the 
body section. A posture angle of the robot can be expressed 
using a virtual joint angle of a virtual link. 

The fundamental constraint condition setter provided 
for each kind of constraint expresses the movement 
constraint condition imposed corresponding to a task and a 
movement state of the robot as a linear equality equation of 
the state variable variation. That is, there are provided 
fundamental constraint condition setters for establishing 
constraint conditions every kinds of constraints such as a 
link original-point position, a link posture, a link gravity 
center position, a joint angle, an entire gravity center 
position, and an entire angular momentum. Each fundamental 
constraint condition setter has a function to generate a 
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parameter for describing a linear constraint equation 
regarding to the corresponding kind of constraint. In 
accordance with various equality constraint demands 
generated during execution of a task, by selectively using 
such a fundamental constraint condition setter, linear 
equality movement constraint conditions can be generated for 
the entire robot. 

Alternatively, the fundamental constraint condition 
setter provided for each kind of constraint expresses the 
movement constraint condition imposed corresponding to a 
task and a moving state of the robot using a linear 
inequality equation of a joint angular variation, etc. For 
example, there are provided fundamental constraint setters 
for establishing movement constraint conditions every kind 
of constraints such as an angular velocity limit and a 
movable angle limit of joints, and each fundamental 
constraint setter has a function to generate a parameter for 
describing the linear inequality equation regarding to the 
corresponding kind of constraint. In accordance with 
various inequality-constraint demands generated during 
execution of a task, by selectively using such a fundamental 
constraint setter, movement constraint conditions defined by 
the linear inequality equations about the entire robot can 
be generated. 

In accordance with a second aspect of the present 
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invention, in a movement control system for a robot having a 
base and a plurality of movable regions connected to the 
base, the system includes fundamental redundancy drive- 
method setters for setting redundancy drive-methods, which 
are changed in accordance with a task and a movement state 
applied to the robot, for each kind of norm; a redundancy 
drive-method setting unit for setting redundancy drive- 
methods of the entire robot by selectively using the 
appropriate fundamental redundancy drive-method setter in 
accordance with a requirement for changes generated during 
execution of a task and a movement of the robot; and a 
drive-amount determining unit for determining a drive amount 
of each of the movable regions so as to satisfy the 
redundancy drive-method set by the redundancy drive-method 
setting unit. 

As norms for driving redundancies, there are the 
minimization of system state changes and the minimization of 
the target state deviation, for example. In accordance with 
demands for changes in the redundancy drive method generated 
during execution of a task, by selectively using the 
corresponding fundamental redundancy drive-method setter, 
redundancy drive methods can be variously established for 
the entire robot. 

Also, in accordance with a third aspect of the present 
invention, in a movement control system for a robot having a 
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base and a plurality of movable regions connected to the 
base, the system includes equality-constraint condition 
setters for expressing movement constraint-conditions, which 
are imposed in accordance with a task and a movement state 
applied to the robot, for each kind of constraint by a 
linear equality equation of a variation of a state variable; 
an equality-constraint condition setting unit for imposing 
movement-constraint conditions of the entire robot necessary 
for a state variation of the robot by selectively using the 
appropriate equality-constraint condition setter in 
accordance with a requirement for a movement constraint 
generated during execution of a task and a movement of the 
robot; inequality-constraint condition setters for 
expressing movement constraint-conditions, which are imposed 
in accordance with a task and a movement state applied to 
the robot, for each kind of constraint by a linear 
inequality equation of a variation of a state variable; an 
inequality-constraint condition setting unit for imposing 
movement-constraint conditions of the entire robot necessary 
for a state variation of the robot by selectively using the 
appropriate inequality-constraint condition setter in 
accordance with a requirement for a movement constraint 
generated during execution of a task and a movement of the 
robot; fundamental redundancy drive-method setters for 
setting redundancy drive-methods, which are changed in 
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accordance with a task and a movement state applied to the 
robot , for each kind of norm; a redundancy drive-method 
setting unit for setting redundancy drive-methods of the 
entire robot by selectively using the appropriate 
fundamental redundancy drive-method setter in accordance 
with a requirement for changes generated during execution of 
a task and a movement of the robot; and a drive-amount 
determining unit for determining a drive amount of each of 
the movable regions so as to entirely satisfy equality and 
inequality-constraint conditions of the entire robot set by 
the equality-constraint condition setting unit and the 
inequality-constraint condition setting unit, and to 
entirely satisfy redundancy drive-methods of the entire 
robot set by the redundancy drive-method setting unit. 

In such a case, equality and inequality constraint 
conditions about the entire robot and redundancy drive 
methods about the entire robot can be formulated as 
quadratic programming problems. This quadratic programming 
problem can be solved using a numerical analysis method such 
as a dual method, and the variation of the state variable of 
the robot can be obtained (or when the inequality constraint 
is out of consideration, the problem .can also be 
analytically solved using a Lagrange multiplier method, 
etc.). Then, by integrating this state variable variation, 
the state of the robot at a succeeding time can be obtained. 
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Therefore, when the robot simultaneously executes a 
plurality of tasks, the allocation of the drive amount of 
each joint can be determined in real time so as to 
simultaneously satisfy geometrical/dynamical and ever- 
changing various movement constraint conditions. 

According to the present invention, in a legged mobile 
robot arbitrarily structured with open links, arbitrary 
constraints expressed by linear equality equations and 
linear inequality equations regarding to state variations 
can be imposed, such as geometrical constraints about 
positions and postures at every points of links, constraints 
about the entire momentums, and inequality constraints about 
movable ranges and drive velocities of actuators. That is, 
various movement constraints can be imposed to a legged 
mobile robot in an arbitrarily moving state, enabling more 
various tasks to be executed. 

The movement constraints imposed to a legged mobile 
robot are changeable in time corresponding to the moving 
state and the demanded task of the robot. According to the 
present invention, to such ever changeable constraint 
conditions, the system can correspond not with a fixed 
individual algorithm (such as inverted kinematics using 
analytical solution) but with a simplified and unified 
framework that is value changing in a matrix element. 
Therefore, the system can easily and promptly correspond to 
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ever changing various constraint conditions, achieving a 
legged robot capable of flexibly corresponding to demanded 
tasks. 

In the control system according to the present 
invention, for the drive method of redundancies, a plurality 
of drive strategies of the redundancies are established so 
as to be dynamically switchable. The optimum drive method 
of redundancies of a legged robot is dynamically changeable 
according to the robot conditions and kinds of task. 
According to the present invention, a plurality of 
redundancy drive methods such as the minimization of the 
deviation of the target state of the system given in advance 
and the minimization of system state changes can be changed 
only by the establishing method of the matrix value, easily 
achieving a legged robot driven according to situations 
based on the optimum coordinating method of the entire body. 

Other objects, features, and advantages of the present 
invention will become apparent as the following detailed 
description proceeds based on the embodiment of the present 
invention and the attached drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a drawing showing a configuration of degrees 
of freedom of a biped humanoid robot with two arms 
exemplified in the present invention; 
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Fig. 2 is a drawing illustrating a base posture of the 
legged mobile robot shown in Fig. 1; 

Fig. 3 is a schematic block diagram showing a 
configuration of a movement control system for a legged 
walking robot according to an embodiment of the present 
invention; 

Fig. 4 is a flowchart showing control procedures 
achieved by the movement control system for the legged 
walking robot shown in Fig. 3; 

Fig. 5 is a drawing for illustrating the definition of 
a coordinate system; and 

Fig. 6 is a drawing showing an example in that the 
control system according to the present invention is 
incorporated in arising movement control of the legged 
mobile robot. 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 

The present invention provides a control unit for 
determining the allocation of a drive amount for each joint 
in real time so as to simultaneously satisfy various 
movement constraint conditions imposed to a legged mobile 
robot during operation. According to the present invention, 
the legged mobile robot is enabled to flexibly correspond to 
changes in a complicated state of touching ground and to 
easily execute a plurality of tasks simultaneously. An 
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embodiment of the present invention will be described below 
in detail with reference to the drawings. 

Fig. 1 shows a configuration of degrees of freedom of a 
biped humanoid robot with two arms exemplified in the 
embodiment of the present invention. 

The robot according to the embodiment is constructed by 
open link chain trains radially linking via rotary joints 
from a base B, and composed of an arm section with seven 
degrees of freedom, a leg section with six degrees of 
freedom, a waist section with three degrees of freedom, and 
a head with two degrees of freedom. 

The base B is defined by an intersecting point between 
a line connecting lateral hip joints together and a body yaw 
axis. The leg section is connected to the base B, and 
composed of a hip joint with three degrees of freedom (yaw, 
roll, and pitch), a knee joint with one degree of freedom 
(pitch) , and an ankle joint with two degrees of freedom 
(roll and pitch) . The hip section with three degrees of 
freedom (yaw, roll, and pitch) is connected to the base B 
and a chest section C. The arm section is connected to the 
chest section C, and composed of a shoulder joint with three 
degrees of freedom (yaw, roll, and pitch), an elbow joint 
with two degrees of freedom (yaw and pitch) , and a wrist 
joint with two degrees of freedom (roll and pitch) . The 
head is connected to the chest section C, and composed of a 
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neck joint with two degrees of freedom (pan and tilt). 

The state of the legged mobile robot can be expressed 
by a state variable x = [ p Q , oc 0 , 0] T given by arranging a 
position p 0 = (x, y, z) T, an attitude a Q = (G lf 6 2 , 9 3 ) T of 
the base B in a world coordinate system (Eulerian angles 
expression, for example) f and the entire joint angles 0 = 
[ 0 4f . . , On] T - 

Wherein the attitude of the base, as shown in Fig. 2, 
is expressed by a virtual joint angle 0i, 02, ©3 of a virtual 
link with length 0. Where n is the number of joints 
including virtual joints (in the example shown in Fig. 1, n 
= 34), and Q± (i = 1 ... n) expresses the joint angle of the 
joint i. Also, the number of elements N of a state variable 
is set to be N = n + 3 (in the example shown in Fig. 1, N = 
37). However, without introducing the virtual link, the 
technical concept of the present invention can be achieved. 

In the description below, the present state is x 
(vector) , and the variation of the present state x after an 
elapse of minute time dt is dx, so that the movement 
constraint condition is defined with the dx. In particular, 
as shown in equations below, it is considered to impose a 
constraint condition to a movement with a linear equality or 
inequality equation . 
[ Numerical Formula 1] 
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Adx = b 

[ Numerical Formula 2] 

Cdx^d 



In the description below, the formulas 1 and 2 are 
called as an "equality constraint condition" and an 
"inequality constraint condition", respectively. Where A is 
an Lxn matrix; b a vector of dimension L; C an MxN matrix; 
and d a vector of dimension M, and symbol L denotes the 
number of equality constraint conditions; and symbol M the 
number of inequality constraint conditions. In a control 
system for the legged mobile robot according to the 
embodiment, a state variation dx is calculated so as to 
satisfy the above-mentioned equations every a predetermined 
control cycle, so that the entire body joints are driven so 
as to achieve x 1 = x + dx, in which a present state x is 
added by dx. 

The number of constraint conditions L is generally less 
than the dimension of the state variable N. Therefore, the 
state variation dx is not uniquely determined only by 
[ Numerical Formula 1] and [ Numerical Formula 2] . That is, N 
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- L is equivalent to a redundancy, and the drive method of 
this redundancy must be separately established. Whereas, 
according to the present invention, dx is to be established 
so as to minimize an energy function relating to the state 
variation dx as follows. 
[ Numerical Formula 3] 

E = —dx T W -dx + u T dx 
2 

Where W is a symmetric matrix of NxN; and u a vector of 
dimension N. Then, the subject for obtaining the joint 
angular variation dx is formulated as a quadratic 
programming problem which will be shown below. 
[ Numerical Formula 4] 

minis = —dx T -W-dx + u T *dx 
2 

subject to Adx = b, Cdx ^ d 



This quadratic programming problem can be solved using 
a numerical analysis method such as a dual method. When the 
inequality constraint is out of consideration, the problem 
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can also be analytically solved using a Lagrange multiplier 
method, etc. 

That is, according to the present invention, movement 
constraint conditions imposed to the legged robot 
corresponding to a task and a movement state are given by 
the linear constraint equations [ Numerical Formula 1] and 
[ Numerical Formula 2] regarding to the variation dx from the 
present state, while the drive strategy of the redundancy is 
defined by the energy function [ Numerical Formula 3] . In 
regard to changes in the movement constraint condition, it 
is not required to have control systems specialized for each 
constraint condition but the changes can be corresponded 
only by changes in the matrixes A and C and the vectors b 
and d, so that various and dynamic constraint conditions are 
easily addressed. Also, regarding to the using method of 
the redundancy, it can be corresponded only by changes in 
the matrix W and the vector u, so that various and dynamic 
drive methods of the redundancy may be provided. 

Fig. 3 schematically shows the configuration of the 
movement control system for the legged walking robot 
according to the embodiment of the present invention. As 
shown in the drawing, this movement control system is 
defined by an equality-constraint condition setting unit 2-1 
an inequality-constraint condition setting unit 2-2, a 
redundancy drive method setting unit 2-3, an equality- 
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constraint condition setter group 2-4 , an inequality 
constraint-condition setter group 2-5 , a redundancy drive 
method setter group 2-6, an equality-constraint condition 
setting space 2-7, an equality-constraint condition setting 
space 2-8, a redundancy drive method setting space 2-9, a 
quadratic-programming problem solver 2-10, an integrator 2- 
11, and an entire body joint driver 2-12. 

The equality-constraint condition setting unit 2-1 sets 
the conditions expressed by a linear equality equation of 
the state variable variation among constraint conditions 
imposed to the robot corresponding to a task and a movement 
state thereof. For example, the conditions correspond to 
constraints regarding to an original point position of a 
link, a link posture, a gravity center position of a link, a 
joint angle, a gravity center position of the entire body, 
and an entire angular momentum. 

These constraint conditions expressed by linear 
equality equations are established in the matrix A and the 
vector b within the equality-constraint condition setting 
space 2-7. The equality-constraint condition setter group 
2-4 is provided with equality-constraint condition setters 
for setting constraint conditions every constraints (or 
controlled objects) , such as an original point position of a 
link, a link posture, a gravity center position of a link, a 
joint angle, a gravity center position of the entire body, 
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and an entire angular momentum. Each equality-constraint 
condition setter has a function to generate a parameter for 
describing a linear constraint equation regarding to the 
corresponding kind of constraint. According to the 
embodiment, the equality-constraint condition setters 
linearly express the constraint equations in a Jacobian form, 
which will be described later in detail. 

Then, the equality condition setting unit 2-1 
appropriately uses the corresponding equality-constraint 
condition setter selected from the equality-constraint 
condition setter group 2-4 corresponding to various equality 
constraint demands generated during executing a task so as 
to establish an appropriate value in the matrix A and the 
vector b within the equality-constraint condition setting 
space 2-7, resulting in generating constraint conditions of 
the entire robot by liner equality equations. 

The inequality constraint condition setting unit 2-2 
establishes conditions expressed by linear inequality 
equations such as an angular variation of a joint among 
constraint conditions imposed corresponding to a task and a 
movement state of the robot. For example, these correspond 
to constraints regarding to an angular velocity limit and a 
movable angle limit of joints. 

These constraint conditions expressed by the linear 
inequality equations are established in the matrix C and the 
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vector d within the inequality-constraint condition setting 
space 2-8. The inequality constraint condition setter group 
2-5 is provided with inequality-constraint condition setters 
for setting constraint conditions every constraints (or 
controlled objects) , such as an angular velocity limit and a 
movable angle limit of joints. Each inequality-constraint 
condition setter has a function to generate a parameter for 
describing a linear inequality equation regarding to the 
corresponding kind of constraint. A more specific 
structuring method of the inequality constraint condition 
setter will be described later in detail. 

Then, the inequality condition setting unit 2-2 
appropriately uses the corresponding inequality-constraint 
condition setter selected from the inequality-constraint 
condition setter group 2-5 corresponding to various 
inequality constraint demands generated during executing a 
task so as to establish an appropriate value in the matrix C 
and the vector d within the inequality-constraint condition 
setting space 2-8, resulting in generating constraint 
conditions of the entire robot by liner inequality equations. 

The redundancy drive method setting unit 2-3 
establishes drive methods of redundancies changing 
corresponding to a task and a movement state of the robot. 
In the drive method of the redundancy, there may be the 
norms of the minimization of system state changes and the 
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minimization of the target state deviation. 

These norms for driving redundancies are established in 
the matrix W and the vector u within the redundancy drive 
method setting space 2-9. The redundancy drive method 
setter group 2-6 is provided with a fundamental redundancy 
drive method setter for setting redundancy drive methods 
every norms such as the minimization of system state changes 
and the minimization of the target state deviation. Each 
fundamental redundancy drive method setter generates the 
redundancy drive method according to the corresponding norm. 

Then, the redundancy drive method setting unit 2-3 
appropriately uses the corresponding drive method selected 
from the; redundancy drive method setter group 2-6 
corresponding to change demands generated during executing a 
task so as to establish an appropriate value in the matrix W 
and the vector u within the redundancy drive method setting 
space 2-9, resulting in establishing desired redundancy 
drive methods of the entire robot. 

The quadratic programming problem solver 2-10 
formulates the equality-constraint conditions established in 
the equality-constraint condition setting space 2-7, the 
inequality constraint conditions established in the 
inequality constraint condition setting space 2-8, and the 
inequality constraint drive methods established in the 
redundancy drive method setting space 2-9 as quadratic 
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programming problems (see the above-description and 
[ Numerical Formula 4] ) so as to calculate the state variable 
variation dx simultaneously satisfying these constraint 
conditions and the redundancy drive methods . 

The integrator 2-11 calculates the state variable value 
at a succeeding time x = x + dx by adding the state variable 
variation dx calculated by the quadratic programming problem 
solver 2-10 to the present state variable value x. The 
entire body joint driver 2-12 servo-drives each joint 
(position) in the robot based on the state variable value at 
a succeeding time calculated by the integrator 2-11. 

Fig. 4 is a flowchart of the control procedure achieved 
by the movement control system for the legged walking robot 
shown in Fig. 3. 

First, equality constraint conditions regarding to an 
original point position of a link, a link posture, a gravity 
center position of a link, a joint angle, a gravity center 
position of the entire body, and an entire angular momentum 
are entered corresponding to a task and a movement state of 
the robot from a user program, for example (Step SI) . 

Then, when the equality-constraint conditions entered 
at the previous step SI are entered in the equality- 
constraint condition setting unit 2-1, the values are 
established for imposing the equality-constraint conditions 
to the equality-constraint condition setting matrix A and 
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the equality-constraint condition setting vector b within 
the equality-constraint condition setting space 2-7 by 
selectively using the equality-constraint condition setter 
group 2-4 (Step S2) . 

Next, the inequality constraint conditions regarding to 
an angular velocity limit and a movable angle limit of 
joints are entered from a user program, for example (Step 
S3) . 

Then, when the inequality-constraint conditions entered 
at the previous step S3 are entered in the inequality- 
constraint condition setting unit 2-2, the values are 
established for imposing the inequality-constraint 
conditions to the inequality-constraint condition setting 
matrix C and the inequality-constraint condition setting 
vector d within the inequality-constraint condition setting 
space 2-8 by selectively using the inequality-constraint 
condition setter group 2-5 (Step S4) . 

Next, the redundancy drive methods are entered 
according to situations and based on the norms such as the 
minimization of system state changes and the minimization of 
the target state deviation from a user program, for example 
(Step S5) . 

Then, the redundancy drive methods entered at the 
previous step S5 are entered in the redundancy drive method 
setting unit 2-3, and the appropriate values are established 
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in the redundancy drive method setting matrix W and the 
redundancy drive method setting vector u within the 
redundancy drive method setting space 2-9 via the redundancy 
drive method setter group 2-6 (Step S6) . 

Next, the quadratic programming problems (see the 
above-description and [ Numerical Formula 4] ) established in 
the equality-constraint condition setting space 2-7, the 
inequality constraint condition setting space 2-8 , and the 
redundancy drive method setting space 2-9 at steps S2, S4, 
and S6 are solved so as to calculate the state variable 
variation dx so as to simultaneously satisfy the constraint 
conditions and the redundancy drive methods designated by a 
user (Step S7 ) . 

Furthermore, using the integrator 2-11, the state 
variable variation is numerically integrated so as to obtain 
the state variable value at a succeeding time (Step S8). 

Then, the joint angular value at a succeeding time 
calculated at the previous step S8 is fed to the entire body 
joint driver 2-12 as a reference value so as to perform a 
positional servo. 

The above procedures are executed every a predetermined 
control cycle dt (dt = 10 milliseconds, for example) . 

The equality-constraint condition setter group 2-7 will 
be described below with reference to a specific example. 

As described above, the equality-constraint condition 
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is expressed by a linear constraint equation regarding to 
the variation dx of the present state x after an elapse of 
minute time dt (see [ Numerical Formula 1] ) . According to 
the embodiment, a Jacobian form is used for linearly 
expressing the relationship between minute variations. 

For example, a fundamental constraint condition setter 
for a link original-point position may be configured using a 
Jacobian form regarding to the original point position in a 
link coordinate system. In this specification, a link 
connected to a parent link via the joint i denotes the link 
i; and a link coordinate system is designated by a 
coordinate system identical in posture to the link i placed 
at the interface between the parent link and the link i. 
The original point position velocity dp_i/dt (three 
dimension vector) of the link i can be expressed by Jacobian 
Jp_i (3 x N matrix) regarding to the original point position 
velocity of a state variable velocity dx/dt (N dimension 
vector) . 

[ Numerical Formula 5] 




= J 




dt 



dt 



The Jacobian J p -± regarding to the original point 
position velocity of the link i can be obtained by the 
following equations : 
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[ Numerical Formula 6] 
the first row of J p _± = [ 1, 0, 0] T 
the second row of J p _i = [ 0, 1, 0] T 
the third row of J p _ ± = [ 0, 0, 1] T 

the (k + 3)th row of J p _i = 0 (in the case where the link k 
does not exist on the straight line connecting between the 
base B and the link i) , or z_k x (p_i-p_k) (in the case 
where the link k does not exist on the straight line 
connecting between the base B and the link i) . 

Wherein the z_k expresses the vector of the joint k in 
the rotation axial direction; and the P_i and the p_k 
designate the positions of the link i and the link k, 
respectively (see Fig. 5) . From the above [ Numerical 
Formula 5] , between the original point position minute 
variation dp_i of the link i and the minute variation dx of 
the state variable x, the following relationship is 
approximately effected: 
[ Numerical Formula 7] 

dp _i = J p f dx 

Therefore, in the case where the movement constraint is 
required and imposed to the original point position of the 
link i in the x, y, and z directions so as to generate the 
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minute variations dp_ix, dp__iy, dp__iz, respectively, the 
following equality constraints may be imposed: 
[ Numerical Formula 8] 

dp _ix = J p ix dx 



[ Numerical Formula 9] 

dp_iy = J p iy dx 

[ Numerical Formula 10] 

dp_iz = J p iz dx 



Wherein, J p _i x, J p _i y, and J p _± z designate the first, 
second, and third lines of J p _±, respectively. When a link 
original point position constraint is demanded to a link 
original point position controller, the link original point 
position controller establishes the coefficients of the 
above equations of [ Numerical Formula 8] to [ Numerical 
Formula 10] on new lines of the equality-constraint 
condition setting matrix A and the equality-constraint 
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condition setting vector b in the equality-constraint 
condition setting space 2-7. For example, when the 
constraint regarding to the position in the x direction of 
the link original point is demanded, according to the 
equation [ Numerical Formula 8] , J p _i x and dp_i x are replaced 
in the new lines of the equality-constraint condition 
setting matrix A and the equality-constraint condition 
setting vector b, respectively. 

Similarly, a link posture controller can be configured 
using a Jacobian form regarding to a link angular velocity. 
The posture angular velocity co_i (three dimension vector) of 
the link i can be expressed by Jacobian Jo_i (3 sx N matrix) 
regarding to the state variable dx/dt (N dimension vector) 
and the angular velocity of the link i. 
[ Numerical Formula 11] 



dx 



Wherein, the Jacobian Joji regarding to the angular 
velocity of the link i is given by the following equations: 
[ Numerical Formula 12] 
the first row of Jco_i = [ 0, 0, 0] T 
the second row of J© i = [ 0, 0, 0] T 
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the third row of Jco_i = [ 0, 0, 0] T 

the (k + 3)th row of J©_i = 0 (in the case where the link k 
does not exist on the straight line connecting between the 
base B and the link i) , or z_k (in the case where the link k 
does not exist on the straight line connecting between the 
base B and the link i) . 

From the above [ Numerical Formula 11] , between the 
original point position minute variation dot_i of the link i 
posture (assumed to be expressed by an Eulerian angle) and 
the minute variation dx of the state variable x, the 
following relationship is approximately effected: 
[ Numerical Formula 13] 



da _i-T _i J ^ f dx 



Wherein, T_i is a matrix converting an angular velocity 
vector into an Eulerian angular vector. Therefore, in the 
case where the movement constraint is required and imposed 
to the link i in the x, y, and z directions so as to 
generate the minute' Eulerian angular variations da_ix, da_iy, 
doc_iz, respectively, the following equality constraints may 
be imposed. 

[ Numerical Formula 14] 
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da _ ix = J a ix dx 



t Numerical Formula 15] 

da_iy = J aiy dx 



[ Numerical Formula 16] 

da _iz = J a iz dx 



Wherein, J a _± x, J a _± y, and J a _± z designate the first, 
second, and third lines of the matrix (T_i Jco_i) , 
respectively- When a link posture constraint is demanded to 
a link posture controller, the link posture controller 
establishes the coefficients of the above equations of 
[ Numerical Formula 14] to [ Numerical Formula 16] on new 
lines of the equality-constraint condition setting matrix A 
and the equality-constraint condition setting vector b in 
the equality-constraint condition setting space 2-7 . For 
example, when the constraint regarding to the posture in the 
x direction of the link i is demanded, according to the 
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equation [ Numerical Formula 14] , J a _± x and dct_i x are 
replaced in the new lines of the equality-constraint 
condition setting matrix A and the equality-constraint 
condition setting vector b, respectively . 

A link gravity center position controller can be 
configured in the same way as in the link original point 
position controller. That is, the gravity center position 
velocity dr_i/dt (three dimension vector) of the link i can 
be expressed by Jacobian J r _± (3 x N matrix) regarding to the 
state variable dx/dt (N dimension vector) and the gravity 
center position velocity of the link i. 
[ Numerical Formula 17] 

dr _i dx 

~dT~ pg - j Tt 



The Jacobian J pg _± regarding to the original point 
position velocity of the link i can be obtained by the 
following equations : 
[ Numerical Formula 18] 
the first row of J r _ ± = [ 1, 0, 0] T 
the second row of J r _± = [ 0, 1, 0] T 
the third row of J r _± = [ 0, 0, 1] T 

the (k + 3)th row of J© i = "0 (in the case where the link k 
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does not exist on the straight line connecting between the 
base B and the link i) , or z__k x (r_i-p_k) (in the case 
where the link k does not exist on the straight line 
connecting between the base B and the link i) . 

Wherein the z_k expresses the vector of the joint k in 
the rotation axial direction; and the r_i and the p_k 
designate the positions of the link i gravity center and the 
link k, respectively (see Fig. 5) . From the above 
[ Numerical Formula 17] , between the gravity center position 
minute variation dr_i of the link i and the minute variation 
dx of the state variable x, the following relationship is 
approximately effected: 
[ Numerical Formula 19] 



dr _i = J r f dx 



Therefore, in the case where the movement constraint is 
required and imposed to the gravity center position of the 
link i in the x, y, and z directions so as to generate the 
minute variations dr_ix, dr_iy, dr_iz, respectively, the 
following equality constraints may be imposed: 
[ Numerical Formula 2 0] 
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dr_ix = J r ix dx 



[ Numerical Formula 21] 

dr_iy = J r dx 



[ Numerical Formula 22] 

dr_iz = J riz dx 



Wherein, J r _± x, J r _± y, and J r _± z designate the first, 
second, and third lines of J r _i, respectively- When a link 
gravity center position constraint is demanded to a link 
gravity center position controller, the link gravity center 
position controller establishes the coefficients of the 
above equations of [ Numerical Formula 20] to [ Numerical 
Formula 22] on new lines of the equality-constraint 
condition setting matrix A and the equality-constraint 
condition setting vector b in the equality-constraint 
condition setting space 2-7. For example, when the 
constraint regarding to the link gravity center position in 
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the x direction is demanded, according to the equation 
[ Numerical Formula 20] , J r _i x and dr_i x are replaced in the 
new lines of the equality-constraint condition setting 
matrix A and the equality-constraint condition setting 
vector b, respectively. 

An entire gravity center position controller imposes 
constraints on the gravity center position of the entire 
robot. The entire gravity center position velocity dr/dt 
(three dimension vector) can be expressed by a state 
variable velocity dx/dt (N dimension vector) and a Jacobian 
J r (3 x N matrix) . 
[ Numerical Formula 2 3] 



The Jacobian J r regarding to the gravity center position 
velocity of the robot can be obtained by the following 
equation: 

[ Numerical Formula 2 4] 



dr 
dt 




dx 



dt 
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lr = Yu m - i l M Jri 

Where m_i denotes a mass of the link i; M a mass of the 
entire robot; and J r _± a Jacobian regarding to the gravity 
center position velocity of the link i. From the above 
[ Numerical Formula 23] , between the gravity center position 
minute variation dr of the entire robot and the minute 
variation dx of the state variable x, the following 
relationship is approximately effected: 
[ Numerical Formula 25] 

dr = J r dx 

Therefore, in the case where the movement constraint is 
required and imposed to the gravity center position of the 
entire robot in the x, y, and z directions so as to generate 
the minute variations dr_x, dr_y, dr_z, respectively, the 
following equality constraints may be imposed: 
[ Numerical Formula 2 6] 
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dr _x = J r x dx 

[ Numerical Formula 27] 

dr_y = J ry dx 

[ Numerical Formula 2 8] 

dr z = J r z dx 

Whe rein, J r _x/ Jr_y/ and J r _z designate the first, second, 
and third lines of J r , respectively. When a gravity center 
position constraint of the entire robot is demanded to the 
entire gravity center position controller, the entire 
gravity center position controller establishes the 
coefficients of the above equations of [ Numerical Formula 
26] to [ Numerical Formula 28] on new lines of the equality- 
constraint condition setting matrix A and the equality- 
constraint condition setting vector b in the equality- 
constraint condition setting space 2-7. For example, when 
the constraint regarding to the gravity center position of 
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the entire robot in the x direction is demanded, according 
to the equation [ Numerical Formula 2 6] , J r _ x x and dr_x are 
replaced in the new lines of the equality-constraint 
condition setting matrix A and the equality-constraint 
condition setting vector b, respectively. 

An entire angular momentum controller imposes 
constraints on the angular momentum variation of the entire 
robot. The angular momentum L (three dimension vector) of 
the entire robot can be expressed by a state variable 
velocity dx/dt (N dimension vector) and a Jacobian J L (3 x N 
matrix) regarding to the angular momentum of the entire 
robot . 

[ Numerical Formula 2 9] 



The Jacobian J L regarding to the angular momentum of the 
entire robot can be obtained by the following equation: 
[ Numerical Formula 30] 




7 t ='f X(mj(rJ-r))) ri+ l_iJ 

1=1 
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Wherein, X(v) denotes a skew-symmetric matrix for 
converting the exterior-product calculation of a vector into 
matrix representation; m_i a mass of the link i; rj a 
gravity center position of the link i; r a gravity center 
position of the entire robot; J r _± a Jacobian regarding to 
the gravity center position velocity of the link i; I_i an 
inertia matrix of the link i; and Ja>_i a Jacobian regarding 
to the angular velocity of the link i. From the above 
[ Numerical Formula 30] , between the angular momentum minute 
variation dL of the entire robot and the minute variation dx 
of the state variable x, the following relationship is 
approximately effected: 
[ Numerical Formula 31] 



dL = J L dx 



Therefore, in the case where the movement constraint is 
required and imposed to the angular momentum of the entire 
robot in the x, y, and z directions so as to generate the 
minute variations dL_x, dL_y, dL_z, respectively, the 
following equality constraints may be imposed: 
[ Numerical Formula 32] 
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dLx = J L x dx 



[ Numerical Formula 33] 

dL_y = J Ly dx 



[ Numerical Formula 3 4] 

dL_z =/ Lz dx 



Wherein, J L _x/ Jj,_yr and J L _ Z designate the first, second, 
and third lines of J r , respectively. When an entire gravity 
center position constraint of the robot is demanded to the 
entire gravity center position controller, the entire 
gravity center position controller establishes the 
coefficients of the above equations of [ Numerical Formula 
32] to [ Numerical Formula 34] on new lines of the equality- 
constraint condition setting matrix A and the equality- 
constraint condition setting vector b in the equality- 
constraint condition setting space 2-7. For example, when 
the constraint regarding to the angular momentum of the 
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entire robot about the x direction is demanded, according to 
the equation [ Numerical Formula 32] , J L _x x and dL_x are 
replaced in the new lines of the equality-constraint 
condition setting matrix A and the equality-constraint 
condition setting vector b, respectively. 

A joint angle controller can be easily configured as 
follows, for example. That is, the deviation AG k between the 
present joint angle 0k and the target joint angle 0k_ o of the 
joint k is to follow the equation below. 
[ Numerical Formula 35] 

In this case, the equality constraint shown in the 
equation below may be imposed. 
[ Numerical Formula 3 6] 

dO k = A0 t 

When a constraint is demanded so that the joint angular 
displacement of the joint k becomes A0 k . According to the 
above equation of [ Numerical Formula 36] , e__{ k + 3} T and A0 k 
are replaced on new lines of the equality-constraint 
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condition setting matrix A and the equality-constraint 
condition setting vector b, respectively. Where e_{ k + 3} 
is an N dimension unit vector with one (k + 3)th element. 

Similarly, an inequality constraint condition setter 
group can also be configured. For example, when the maximum 
angular velocity of the joint k is d0 k /dt__max, the joint 
angular velocity controller may be imposed by the inequality 
constraint condition as shown in the equation below. 
[ Numerical Formula 37] 



Regarding to a movable angle controller, when the 
present joint angle is 0k; the maximum joint angle 9k_max; and 
the minimum joint angle 0k_min of the joint k, the inequality 
constraint condition shown in the following equation may be 
imposed: 

[ Numerical Formula 38] 



\dO k \< 



dt 



dt max 



0 t 



k min 



-0 k <d0 t <0 t 



k max 
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In any of the inequality condition setters, 
coefficients of the above-inequality equations are 
established on the inequality constraint condition setting 
matrix C and the inequality constraint condition setting 
vector d within the inequality constraint condition setting 
space 2-8. 

Also, regarding to the redundancy drive method setter 
group, according to manners in setting values of the matrix 
and vector, various strategies for driving redundancies can 
be applied. For example, in a redundancy drive method 
setter for a state variation minimizing norm for minimizing 
the state variation from the preceding time: 
[ Numerical Formula 39] 

1 T 

E = —dx dx 
2 



the redundancy drive method setting matrix W and the 
redundancy drive method setting vector u may be established 
within the redundancy drive method setting space 2-9 so as 
to satisfy the above equation. That is, the system is 
configured so as to establish the below equation: 
[ Numerical Formula 4 0] 
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W = I, u = 0 

Also, in a redundancy drive method setter of a state 
variation minimizing norm for minimizing the deviation to a 
target state xO : 
[ Numerical Formula 41] 

i i=N 

F = ^H w - i (xO_i-(x_i + dx_i)f 



so as to minimize coefficients including dx of the above 
equation; 

[ Numerical Formula 42] 



E = dx T diag(w _ i)dx + (w\x- xO) T dx 



the redundancy drive method setting matrix W and the 
redundancy drive method setting vector U may be established 
within the redundancy drive method setting space 2-9. That 
is, the system is configured so as to establish the below 



- 49 - 



equation : 

[ Numerical Formula 4 3] 

W = diag(w_i\ u = (w\x- xO) 



Where w denotes an N dimension vector having the ith 
factor with a positive real number w_i; and xO_i denotes the 
ith element of xo. Also, diag (w_i) denotes an N x N 
diagonal matrix having the ith diagonal element of w_i; and 
(a | b) denotes an N dimension vector having the ith element 
with the ith element of a multiplied by the ith element of b. 

According to the configuration described above, a 
legged mobile robot can be controlled so as to operate by 
determining the allocation of the dive amount of each joint 
in real time so as to simultaneously satisfy various 
constraint conditions imposed during execution. 

Fig. 6 shows an example in that the control system 
according to the present invention is incorporated in 
arising movement control of a legged mobile robot. 

Between time 0.0 sec and time 2.0 sec, constraints are 
imposed on a robot so that the height of pawns is 
constrained on a floor; the position and posture of soles 
are constrained on the floor; and the gravity center traces 
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a backing and rising track. These constraints are entered 
via the equality constraint condition setting unit 2-1 as 
constraints regarding to the state variation of the system 
after the control cycle dt, and appropriate values are 
established to the equality-constraint condition setting 
matrix A and the equality-constraint condition setting 
vector b within the equality-constraint condition setting 
space 2-7 by the equality-constraint condition setter group 
2-4. 

As shown in Fig. 6, in this period, on each row of the 
equality-constraint condition setting matrix A, a Jacobian 
regarding to a hand section in the Z direction, a velocity 
Jacobian of a leg section in the X, Y, and Z directions, a 
posture angular velocity Jacobian of the leg section in the 
X, Y, and Z directions, and a Jacobian of the entire gravity 
center in the X, Y, and Z directions are recalculated every 
control cycles and replaced, while on the row regarding to 
the gravity center position constraint of the equality- 
constraint condition setting vector b, a displacement which 
must be changed during the control cycle (symbol + denotes a 
positive value; symbol - negative) is replaced, and on the 
row other than the above, 0 designating the variation 0 is 
replaced. 

In the example shown in the drawing, a state-variation 
minimizing norm is used for the redundancy drive method. 
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Quadratic programming problems are solved every control 
cycles so as to satisfy these constraint conditions. Based 
on the results, moving states of the entire body are 
depicted as images on the left column of the drawing. In 
this period, it may be understood from the drawing that the 
entire body is driven so as to satisfy the entire constraint 
conditions while appropriately using the redundancies. 

Upon approaching time 3.0 sec, the constraint regarding 
to the hand section in the Z direction is cancelled. After 
that time, it is understood that the row regarding to the 
hand section in the Z direction is not inserted in the 
equality-constraint condition setting matrix A and the 
equality-constraint condition setting vector b. Also from 
the images on the left column, it can be seen that the 
constraint to the pawn is released so that the hand section 
starts to rise . 

Furthermore, upon approaching time 5.0 sec, for pulling 
the hand section to the waist, a new constraint is imposed 
to the hand section so as to follow the backing track. In 
connection with this, rows regarding to the hand position 
constraint in the X direction are inserted in the equality- 
constraint condition setting matrix A and the equality- 
constraint condition setting vector b. 

From .the images on the left column, it may be 
understood that the entire body is subsequently driven so 



- 52 - 



that the X-coordinate of the hand section decreases. In 
such a manner, by the control system according to the 
present invention, dynamic changes in the constraint 
condition during the operation of body can be easily 
corresponded only by the update of the values of the matrix 
and vector, so that the allocation of the drive amount for 
the entire joints of the body can be determined in real time 
so as to entirely satisfy the demanded constraint conditions. 

The present invention has be described with reference 
to a specific embodiment in detail. However, it is obvious 
that those skilled in the art can make modifications within 
the scope and spirit of the present invention. 

The scope of the present invention is not necessarily 
limited to a product called as a "robot". That is, products 
pertaining to other industrial fields such as toys may 
similarly incorporate the present invention as long as the 
products are machines or general movable devices simulating 
human movements. 

After all, the present invention has been disclosed by 
exemplification, so that the description of this 
specification must not be definitely construed. In order to 
determine the spirit of the present invention, the attached 
claims must be considered. 

As described below in detail, according to the present 
invention, an excellent movement control system can be 



- 53 - 



provided for a legged walking robot capable of 
simultaneously executing a plurality of tasks such as a 
displacement , balance keeping, and an arm operation. 

Also, according to the present invention, an excellent 
movement control system can be provided for a legged walking 
robot capable of determining the allocation of the drive 
amount of each joint in real time so as to simultaneously 
satisfy various movement constraint conditions imposed by 
each task. 

Also, according to the present invention, an excellent 
movement control system can be provided for a legged walking 
robot capable of operating by suitably allocating drive 
amounts of degrees of freedom of an entire body so as to 
simultaneously satisfy geometrical/dynamical and ever- 
changing various movement constraint conditions. 

The control system according to the present invention 
is not definitely applied to a specific movement state such 
as walking but has high versatility applicable to an 
arbitrary movement state of a legged mobile robot. In a 
legged mobile robot arbitrarily structured with open links, 
arbitrary constraints expressed by linear equality equations 
and linear inequality equations regarding to state 
variations can be imposed, such as geometrical constraints 
about positions and postures at every points of links, 
constraints about the entire momentums, and inequality 
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constraints about movable ranges and drive velocities of 
actuators. According to the present invention, various 
movement constraints can be imposed to a legged mobile robot 
in an arbitrarily moving state, enabling more various tasks 
to be executed. 

The control system according to the present invention 
also has an advantage that the system can correspond to 
dynamic changes in the movement constraint conditions 
imposed to a moving legged mobile robot without being 
limited to fixed movement constraint problems. The movement 
constraints imposed to a legged mobile robot are changeable 
in time corresponding to the moving state and the demanded 
task of the robot. According to the present invention, to 
such ever changeable constraint conditions, the system can 
correspond not with a fixed individual algorithm (such as 
inverted kinematics using analytical solution) but with a 
simplified and unified framework that is value changing in a 
matrix element. Therefore, the system can easily and 
promptly correspond to ever changing various constraint 
conditions, achieving a legged robot capable of flexibly 
corresponding to demanded tasks. 

In the control system according to the present 
invention, for the drive method of redundancies, a plurality 
of drive strategies of the redundancies are established so 
as to be dynamically switchable. The optimum drive method 
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of redundancies of a legged robot is dynamically changeable 
according to the robot conditions and kinds of task. 
According to the present invention, a plurality of 
redundancy drive methods such as the minimization of the 
deviation of the target state of the system given in advance 
and the minimization of system state changes can be changed 
only by the establishing method of the matrix value, easily 
achieving a legged robot driven according to situations 
based on the optimum coordinating method of the entire body. 



